package at.technikum_wien.embsys.aat.PriscillaCore.telegram;

import at.technikum_wien.embsys.aat.PriscillaCore.enums.ESP3_CommandType;

public class TelegramESP3 {
	
	static final int MESSAGE_LEN = 100;
	  /**
	   * CRC-8 lookup table (see EnOcean Serial Protocol 3 V1.17 Specification
	   * chapter 2.3: CRC8 calculation).
	   */
	  private static final byte[] CRC8_TABLE = new byte[] {
	      (byte)0x00, (byte)0x07, (byte)0x0e, (byte)0x09, (byte)0x1c, (byte)0x1b, (byte)0x12, (byte)0x15,
	      (byte)0x38, (byte)0x3f, (byte)0x36, (byte)0x31, (byte)0x24, (byte)0x23, (byte)0x2a, (byte)0x2d,
	      (byte)0x70, (byte)0x77, (byte)0x7e, (byte)0x79, (byte)0x6c, (byte)0x6b, (byte)0x62, (byte)0x65,
	      (byte)0x48, (byte)0x4f, (byte)0x46, (byte)0x41, (byte)0x54, (byte)0x53, (byte)0x5a, (byte)0x5d,
	      (byte)0xe0, (byte)0xe7, (byte)0xee, (byte)0xe9, (byte)0xfc, (byte)0xfb, (byte)0xf2, (byte)0xf5,
	      (byte)0xd8, (byte)0xdf, (byte)0xd6, (byte)0xd1, (byte)0xc4, (byte)0xc3, (byte)0xca, (byte)0xcd,
	      (byte)0x90, (byte)0x97, (byte)0x9e, (byte)0x99, (byte)0x8c, (byte)0x8b, (byte)0x82, (byte)0x85,
	      (byte)0xa8, (byte)0xaf, (byte)0xa6, (byte)0xa1, (byte)0xb4, (byte)0xb3, (byte)0xba, (byte)0xbd,
	      (byte)0xc7, (byte)0xc0, (byte)0xc9, (byte)0xce, (byte)0xdb, (byte)0xdc, (byte)0xd5, (byte)0xd2,
	      (byte)0xff, (byte)0xf8, (byte)0xf1, (byte)0xf6, (byte)0xe3, (byte)0xe4, (byte)0xed, (byte)0xea,
	      (byte)0xb7, (byte)0xb0, (byte)0xb9, (byte)0xbe, (byte)0xab, (byte)0xac, (byte)0xa5, (byte)0xa2,
	      (byte)0x8f, (byte)0x88, (byte)0x81, (byte)0x86, (byte)0x93, (byte)0x94, (byte)0x9d, (byte)0x9a,
	      (byte)0x27, (byte)0x20, (byte)0x29, (byte)0x2e, (byte)0x3b, (byte)0x3c, (byte)0x35, (byte)0x32,
	      (byte)0x1f, (byte)0x18, (byte)0x11, (byte)0x16, (byte)0x03, (byte)0x04, (byte)0x0d, (byte)0x0a,
	      (byte)0x57, (byte)0x50, (byte)0x59, (byte)0x5e, (byte)0x4b, (byte)0x4c, (byte)0x45, (byte)0x42,
	      (byte)0x6f, (byte)0x68, (byte)0x61, (byte)0x66, (byte)0x73, (byte)0x74, (byte)0x7d, (byte)0x7a,
	      (byte)0x89, (byte)0x8e, (byte)0x87, (byte)0x80, (byte)0x95, (byte)0x92, (byte)0x9b, (byte)0x9c,
	      (byte)0xb1, (byte)0xb6, (byte)0xbf, (byte)0xb8, (byte)0xad, (byte)0xaa, (byte)0xa3, (byte)0xa4,
	      (byte)0xf9, (byte)0xfe, (byte)0xf7, (byte)0xf0, (byte)0xe5, (byte)0xe2, (byte)0xeb, (byte)0xec,
	      (byte)0xc1, (byte)0xc6, (byte)0xcf, (byte)0xc8, (byte)0xdd, (byte)0xda, (byte)0xd3, (byte)0xd4,
	      (byte)0x69, (byte)0x6e, (byte)0x67, (byte)0x60, (byte)0x75, (byte)0x72, (byte)0x7b, (byte)0x7c,
	      (byte)0x51, (byte)0x56, (byte)0x5f, (byte)0x58, (byte)0x4d, (byte)0x4a, (byte)0x43, (byte)0x44,
	      (byte)0x19, (byte)0x1e, (byte)0x17, (byte)0x10, (byte)0x05, (byte)0x02, (byte)0x0b, (byte)0x0c,
	      (byte)0x21, (byte)0x26, (byte)0x2f, (byte)0x28, (byte)0x3d, (byte)0x3a, (byte)0x33, (byte)0x34,
	      (byte)0x4e, (byte)0x49, (byte)0x40, (byte)0x47, (byte)0x52, (byte)0x55, (byte)0x5c, (byte)0x5b,
	      (byte)0x76, (byte)0x71, (byte)0x78, (byte)0x7f, (byte)0x6A, (byte)0x6d, (byte)0x64, (byte)0x63,
	      (byte)0x3e, (byte)0x39, (byte)0x30, (byte)0x37, (byte)0x22, (byte)0x25, (byte)0x2c, (byte)0x2b,
	      (byte)0x06, (byte)0x01, (byte)0x08, (byte)0x0f, (byte)0x1a, (byte)0x1d, (byte)0x14, (byte)0x13,
	      (byte)0xae, (byte)0xa9, (byte)0xa0, (byte)0xa7, (byte)0xb2, (byte)0xb5, (byte)0xbc, (byte)0xbb,
	      (byte)0x96, (byte)0x91, (byte)0x98, (byte)0x9f, (byte)0x8a, (byte)0x8D, (byte)0x84, (byte)0x83,
	      (byte)0xde, (byte)0xd9, (byte)0xd0, (byte)0xd7, (byte)0xc2, (byte)0xc5, (byte)0xcc, (byte)0xcb,
	      (byte)0xe6, (byte)0xe1, (byte)0xe8, (byte)0xef, (byte)0xfa, (byte)0xfd, (byte)0xf4, (byte)0xf3
	  };
	  
	  
	int[] rawMessage = new int[MESSAGE_LEN];
	String[] rawHexMessage = new String[MESSAGE_LEN];
	String[] rawBinaryMessage = new String[MESSAGE_LEN];
	ESP3_CommandType packetType = ESP3_CommandType.UNKNOWN;
	int nrChar = 0;
	
	
	
	int dataLength, optionalDataLenght;
	
	public TelegramESP3() {
	}

	public TelegramESP3(Telegram telegram) {
		switch(telegram.getORG()) {
		case 0x05:
			this.dataLength = 7;
			this.optionalDataLenght = 7;
			this.packetType = ESP3_CommandType.RADIO;
			
			/**** HEADER ****/
			this.fillMessage("55", 0); //sync header
			this.fillMessage(0, 1); //data length
			this.fillMessage(7, 2); //data length
			this.fillMessage(7, 3); //optional data length
			this.fillMessage(1, 4); //packet type
			this.fillMessage(this.calcCRC(this.rawMessage, 1, 4), 5); //CRC_H
			
			/**** DATA ****/
			
			this.fillMessage("f6", 6); //RORG F6 -> ORG 05
			this.fillMessage(telegram.getData3(), 7);
			this.fillMessage(telegram.getSensorID3(), 8);
			this.fillMessage(telegram.getSensorID2(), 9);
			this.fillMessage(telegram.getSensorID1(), 10);
			this.fillMessage(telegram.getSensorID0(), 11);
			this.fillMessage(telegram.getStatus(), 12);
			
			/**** OPTIONAL DATA ****/
			this.fillMessage("03", 13); //Number of subtelegram; Send: 3 / receive: 1 ... y
			this.fillMessage("FF", 14); //Destination ID   Broadcast
			this.fillMessage("FF", 15); //Destination ID   Broadcast
			this.fillMessage("FF", 16); //Destination ID   Broadcast
			this.fillMessage("FF", 17); //Destination ID   Broadcast
			this.fillMessage("FF", 18); //dBm Send case: FF
			this.fillMessage("00", 19); //Security Level unencrypted

			/**** CRC_D ****/
			this.fillMessage(this.calcCRC(this.rawMessage, 6, this.dataLength+this.optionalDataLenght), (this.dataLength+this.optionalDataLenght + 6)); //CRC_H

			break;
			
		case 0x06:
			//TODO: neues ESP telegramm anfüllen
			break;
			
		case 0x07:
			//TODO: neues ESP telegramm anfüllen
			break;
		}
	}
	public int[] getRawMessage() {
		return rawMessage;
	}
	public byte[] getRawByteHexMessage() {
		int size =  this.dataLength + this.optionalDataLenght + 7;
		byte[] byteArray = new byte[size];
		for (int i = 0; i < size; i++ ) {
			byteArray[i] = (byte) rawMessage[i];
		}
		return byteArray;
	}
	public String[] getRawHexMessage() {
		return rawHexMessage;
	}

	public String[] getRawBinaryMessage() {
		return rawBinaryMessage;
	}

	public void setDataLength(int headerDataLength) {
		this.dataLength = headerDataLength;
		//System.out.println("setHeaderDataLength: " + headerDataLength);
	}
	public void setOptionalDataLenght(int headerOptionalLenght) {
		this.optionalDataLenght = headerOptionalLenght;
		//System.out.println("setHeaderOptionalLenght: " + headerOptionalLenght);
	}
	public void setPacketType(int headerPacketType) {
		
		switch(headerPacketType) {
		case 0x01:
			this.packetType = ESP3_CommandType.RADIO;
			break;
		case 0x02:
			this.packetType = ESP3_CommandType.RESPONSE;
			break;
		case 0x03:
			this.packetType = ESP3_CommandType.RADIO_SUB_TEL;
			break;
		case 0x04:
			this.packetType = ESP3_CommandType.EVENT;
			break;	
		case 0x05:
			this.packetType = ESP3_CommandType.COMMON_COMMAND;
			break;
		case 0x06:
			this.packetType = ESP3_CommandType.SMART_ACK_COMMAND;
			break;	
		case 0x07:
			this.packetType = ESP3_CommandType.REMOTE_MAN_COMMAND;
			break;
		default:
			this.packetType = ESP3_CommandType.UNKNOWN;
			break;
		}
		
		//System.out.println("setHeaderPacketType: " + this.packetType);
	}
	
	
	public int getDataLength() {
		return dataLength;
	}
	public int getOptionalDataLenght() {
		return optionalDataLenght;
	}
	public ESP3_CommandType getPacketType() {
		return packetType;
	}
	
	public String getDataString() {
		String temp = new String();
		
		for(int i = 6; i < (this.getDataLength() + 6); i++) {
			if(rawHexMessage[i].length() < 2) {
				temp = temp + "0" + rawHexMessage[i];
			} else {
				temp = temp + rawHexMessage[i];
			}
		}
		temp = temp.toUpperCase();
		return temp;
	}
	
	public String getFullString() {
		String temp = new String();
		
		for(int i = 0; i < (this.getDataLength() + 7 + this.getOptionalDataLenght()); i++) {
			if(rawHexMessage[i].length() < 2) {
				temp = temp + "0" + rawHexMessage[i];
			} else {
				temp = temp + rawHexMessage[i];
			}
		}
		temp = temp.toUpperCase();
		return temp;
	}
	
	public int getDataIntOffset(int offset) {
		if(offset > this.getDataLength()) return 0xFFFF;
		
		return rawMessage[offset+6];
	}

	
	public void reset() {
		//System.err.println("RESET ");
		for(int i = 0; i < MESSAGE_LEN; i++) {
			rawHexMessage[i] = "";
			rawBinaryMessage[i] = "";
			rawMessage[i] = 0;
		}
		dataLength = optionalDataLenght = 0;
		packetType = ESP3_CommandType.UNKNOWN;
	}
	public void setRawMessage(int data, int offset) {
//		System.out.println("setRawMessage   Data: " + data + "  offset:  " + offset);
		rawMessage[offset] = data;
		rawBinaryMessage[offset] = Integer.toBinaryString(data);
		rawHexMessage[offset] = Integer.toHexString(data);
	}
	
	public int checkCRC() {
		byte crc_temp = 0;
		int index = 0;
		
		//CRC8 for header (data and optional data length, packet type and crc byte)
		for(int i = 1; i < 6; i++) {
			index = crc_temp ^ rawMessage[i];
			index &= 0xFF;
			crc_temp = CRC8_TABLE[index];
		}
		
		if(crc_temp != 0) {
			return crc_temp;
		}
		
		//CRC8 for data
		crc_temp = 0;
		
		//calculate CRC over data, optional data and the crc byte (without header)
		for(int i = 6; i < (this.getDataLength() + this.getOptionalDataLenght() + 6 + 1); i++) {
			index = crc_temp ^ rawMessage[i];
			index &= 0xFF;
			crc_temp = CRC8_TABLE[index];
		}
		
		if(crc_temp != 0) {
			return crc_temp;
		}
		
		return 0;
	}
	
	private byte calcCRC(int[] data, int offset, int len) {
		byte crc_temp = 0;
		int index = 0;
		
		for(int i = offset; i < len+offset; i++) {
			index = crc_temp ^ data[i];
			index &= 0xFF;
			crc_temp = CRC8_TABLE[index];
		}

		return crc_temp;
	}
	
	private void fillMessage(String hex, int index) {
		this.rawHexMessage[index]= hex;
		this.rawMessage[index] = Integer.parseInt(hex, 16);
		this.rawBinaryMessage[index] = Integer.toBinaryString(this.rawMessage[index]);
	}
	
	private void fillMessage(int data, int index) {
		this.rawHexMessage[index]= Integer.toHexString(data);
		this.rawMessage[index] = data;
		this.rawBinaryMessage[index] = Integer.toBinaryString(data);
	}

	public int getSize() {
		return this.dataLength + this.optionalDataLenght + 7;
	}
}
